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Abstract — For  target  tracking  with  radar  measurements,  re¬ 
cursive  LMMSE  (Linear  Minimum  Mean  Squared  Error)  fil¬ 
tering  outperforms  the  popular  measurement  conversion  based 
Kalman  filters,  which  have  some  serious  drawbacks  in  terms  of 
both  estimation  accuracy  and  credibility.  The  existing  recursive 
LMMSE  with  measurements  from  a  single  radar  is  first  extended 
to  the  multi-radar  case.  It  is  then  shown  that  recombination  plays 
an  important  role  in  performance  improvement  for  recursive 
LMMSE  centralized  fusion  using  multiple  radars.  Here,  “re¬ 
combination”  means  shuffling  all  scalar  measurements  from  the 
multiple  radars,  dimension  by  dimension.  This  differs  from  the 
case  of  centralized  fusion  with  linear  measurements  from  multiple 
sensors.  Numerical  simulation  examples  are  provided  to  illustrate 
the  use  of  recombination  in  recursive  LMMSE  centralized  fusion 
for  the  nonlinear  radar  measurements. 

Keywords:  Centralized  fusion,  recombination,  recursive 
LMMSE  filtering,  nonlinear  filtering,  radar  measurements, 
target  tracking. 

I.  Introduction 

In  tracking  applications,  target  dynamics  are  usually  mod¬ 
eled  in  Cartesian  coordinates,  while  the  radar  measurements 
may  be  directly  available  in  polar  or  spherical  coordinates.  Due 
to  the  nonlinear  relationship  between  the  Cartesian  coordinates 
and  polar/spherical  coordinates,  tracking  in  Cartesian  coordi¬ 
nates  using  measurements  available  in  sensor  coordinates  is  in 
essence  a  nonlinear  filtering  problem.  The  general  nonlinear 
filtering  problem,  consisting  of  point  estimation  and  density 
estimation,  has  been  widely  studied  and  a  lot  of  results 
are  available,  e.g.,  extended  Kalman  filter  (EKF),  unscented 
filtering  (UF)  [  1 J,  the  second-order  Stirling  interpolation  based 
filter  (DD2)  [2],  and  Gaussian  filter  [3]  for  point  estimation 
and  particle  filter  [4]  for  density  estimation.  They  can  all 
be  applied  to  target  tracking  in  Cartesian  coordinates  with 
measurements  in  polar/spherical  coordinates.  However,  since 
the  nonlinear  relationship  between  the  Cartesian  coordinates 
and  polar/spherical  coordinates  is  known  explicitly,  specifi¬ 
cally  designed  nonlinear  filters  may  perform  better. 

In  a  track-while-scan  surveillance  system,  the  measurements 
are  usually  range,  bearing,  elevation  and  range  rate  in  polar 
or  spherical  coordinates  [5].  Specifically  designed  nonlinear 
filtering  algorithms  for  this  type  of  problem  abound.  One 

♦Research  supported  in  part  by  ARO  through  grant  W91  INF-08-1-0409 
and  ONR-DEPSCoR  through  grant  N00014-09-1-1 169. 


popular  way  is  to  convert  the  measurement  model  in  the 
polar/spherical  coordinates  to  the  Cartesian  coordinates  so 
that  the  converted  measurement  model  takes  a  pseudo  lin¬ 
ear  form  with  respect  to  the  target  state  described  in  the 
Cartesian  coordinates  and  the  Kalman  filter  can  be  applied. 
Unfortunately,  the  converted  measurement  errors  are  state 
dependent  and  have  bias.  Numerous  ways  have  been  proposed 
to  debias  the  converted  measurements  [5].  For  instance,  [6]— 
[8]  proposed  to  use  additive  debiasing,  and  [9],  [10]  proposed 
to  use  multiplicative  debiasing.  [10],  [11]  extended  debiased 
conversion  to  the  case  when  range  rate  measurements  are 
also  available.  In  a  scan-while-track  surveillance  system,  such 
as  a  phased  array  radar,  the  measurements  are  usually  range 
and  two  direction  cosines  [5].  Specifically  designed  nonlinear 
filtering  algorithms  for  this  type  of  problem  are  also  available. 
For  example,  by  using  the  first-order  and  second-order  Taylor 
series  expansions,  [8],  [12]  developed  Kalman  filters  for  this 
type  of  problem,  again  based  on  debiased  measurement  model 
conversion. 

As  pointed  out  in  [5],  [13],  the  Kalman  filter  based  on 
debiased  conversion  of  the  measurement  model  from  the 
polar/sphericla  coordinates  to  the  Cartesian  coordinates  has  the 
following  serious  drawbacks:  a)  the  converted  measurement 
errors  are  state  dependent;  b)  their  covariances  are  estimated 
conditioned  on  the  measurement  or  state;  c)  the  converted 
measurement  error  sequence  is  not  white  any  more.  However, 
the  Kalman  filter  assumes  the  measurement  noise  is  indepen¬ 
dent  of  the  state,  its  covariance  is  unconditional,  and  it  is 
white.  These  drawbacks  cannot  be  overcome  in  the  existing 
debiased  conversion  based  Kalman  filters.  To  be  free  of  these 
drawbacks,  [13]  and  [14]  proposed  recursive  LMMSE  filtering 
with  respect  to  the  converted  measurements  for  track-while- 
scan  system  and  scan-while-track  system,  respectively. 

For  centralized  fusion  with  multiple  sensors,  a  basic  idea 
is  to  stack  the  measurements  from  all  sensors  first  and  then 
use  the  stacked  measurements  to  replace  measurements  in  the 
traditional  estimation  method.  One  may  think  that  centralized 
fusion  done  this  way  has  the  best  performance  achievable — 
there  is  no  room  to  improve  performance  of  multi-sensor 
centralized  fusion  done  this  way.  This  is  true  for  multi¬ 
sensor  centralized  fusion  with  linear  measurements.  How¬ 
ever,  this  paper  shows  that  this  is  not  true  for  multi-radar 
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centralized  fusion.  The  recursive  LMMSE  for  target  tracking 
with  measurements  from  a  single  radar  in  a  track-while-scan 
system  is  first  extended  to  the  multi-radar  case.  Illustrative 
examples  then  verify  that  recombination1  plays  a  key  role  in 
performance  improvement  using  multiple  radars. 

This  paper  is  organized  as  follows.  Sec.  II  formulates  the 
problem  and  summarizes  recursive  LMMSE  filtering  for  a 
single  radar.  Sec.  Ill  presents  recursive  LMMSE  centralized  fu¬ 
sion  with  measurements  from  multiple  radars.  Sec.  IV  presents 
recursive  LMMSE  centralized  fusion  with  recombined  radar 
measurements.  Sec.  V  provides  illustrative  examples  to  show 
the  use  of  recombination  in  recursive  LMMSE  centralized 
fusion.  Sec.  VI  gives  conclusions. 

II.  Problem  Formulation 

For  the  convenience  of  discussion,  consider  only  the  follow¬ 
ing  target  dynamics  described  in  a  three-dimensional  Cartesian 
coordinate  system 

Xk  =  Fk-iXk-i  +  Gk-iWk-i 

where  Xk  =  [  xfc  xfc  yfc  yk  zk  zk  ]'  is  the  target  state 
vector  at  time  k,  which  consists  of  position  and  velocity  along 
each  direction.  (Wk)  is  a  zero-mean  white  noise  sequence 
with  covariance  Qk,  E[X o]  =  Xq,  cov(Xo)  =  Pq,  and 
cov(X0,  Wk)  =  0. 

Suppose  that  M  radars  co-located  at  the  origin  of  the 
Cartesian  coordinates  are  used  to  observe  the  target  motion. 
In  spherical  coordinates,  the  measurements  from  the  z-th  radar 
at  time  k  are  range  rk,  bearing  (or  azimuth)  bk  and  elevation 
elk.  They  are  observed  as 

4  =  rfc  +  f% 

K  =  bfc  +  bk 
ek  =  ek  +  4 

where 

^  =  (x^  +yt  +  4)1/2 

bk  =  tan_1(y  k/xk) 

ek  =  tan_1(zfc/(x|  +  y  l)1/2) 

are  the  corresponding  groud  truth;  (fk),  (b\)  and  (e\),  which 
are  independent  of  each  other  and  of  Xq  and  (Wk),  are  all 
zero-mean  white  Gaussian  measurement  noise  sequences  with 
standard  deviations  a),  alb  and  u*,  respectively.  It  is  also 
assumed  that  these  noises  are  independent  across  radars. 

The  radar  measurements  in  the  spherical  coordinates  can  be 
converted  into  their  counterparts  in  the  Cartesian  coordinates 
through 

xk  =  rk  cos  e\  cos  b\ 

Vk  =  4  cos  4  sin  blk 
zl  =  rk  sin  e\ 

'in  this  paper,  recombination  means  shuffling  all  scalar  measurements  from 
the  multiple  radars,  dimension  by  dimension. 


For  the  ease  of  comparison,  the  recursive  LMMSE  filtering 
for  Xk  is  summarized  below  [13]. 

Define 


zl  =  i  4  vi  4  ]' 

\\  =  E[cosbk]  =  e~(-‘7b'>  /2 
X’2  =  E[ cos2  bi\  =  (1  +  e_(<7*)2)/2 
X3  =  E[ sin2  4]  =  (1  -  e“(4)2)/2 
n\  =  E[  cos  4]  =  e"(4)2/2 
ti  =  E[  cos24]  =  (l  +  e-(<)2)/2 
4  =  ^Icos2  ek]  =  (1  -  e-(<7')2)/2 
=  diag(AyMi)  Ai/z’n  Mi} 
and  the  recursive  filtering  operation  at  time  k 
[X,  P]  =  filtering(X,  P,  Z,  C ,  S) 

with 

X  =  F^X  +  CS~1Z 

P  =  Fk^PF^  +  Gk-iQk-iG’k^  -  CS~1C' 

Given  Xl^k^  =  P^fc-iK^fc1]  and  = 

MSE(X^_1|fe_1|{Z(}j“11),  where  stands  for  LMMSE 

estimate  of  x  using  z  and  MSE(x|z)  =  E[(x  —  x)(x  — 
the  recursive  LMMSE  filtering  for  Xk  at  the  z-th  radar  can  be 
obtained  as 


P4|fc’4|fc] 

=  filtering(JV^_1|A,_1,PJJ_1|fe_1, 4|fc-i  >  Gfc|fc-i>4) 
where 


zk\k 

-1 

= 

1 

1 

tsj 

4ifc 

-1 

= 

E*[zi\{zi}ktzi] 

= 

-X’fc|fc_i (1)  4fc|fc-i(3)  . 

Xk\k—  1  1 

(5)  ]' 

° k\k 

-1 

= 

COv(Xfc|fc_!,  4|fc-i) 

= 

-Pfc|fc-i(:,  1)  -Pfc|fc-i(:,3) 

pk\k- 

-r0,5)  ] 

si 

= 

[4(™>4)]m,n=l 

4(i, 

i) 

Al244|fc-i(l,l)  +  A>i4|fc- 

-i(3,3) 

+ 

afc(A2[-A’fc|fc-1(l)]2  +  4\.Xk\k- 

-i(3)]2) 

+  4(i) 

4(2, 

2) 

ft! 

A2M2  44-1  (3, 3)  +  \l3lAPk\k- 

-r(l.l) 

+ 

4(AiK,fc_i(l)]2  +  A*[X*|fc_ 

-i(3)]2) 

+  4(2) 

4(3, 

3) 

ft 

«|fc-i(5,5)+MM4|fc-i(l! 

1)+P 

jt|fc-i(3,. 

+ 

4(4)2K|fc-i(5)]2/«)2 

+  /4(4)2(4)2/(4)2]  +  4(3) 

4(1,  2)  =  4(2, 1)  «  (Al  -  Xz)^Pi\k-i(P  3) 

+  afc^fc|fc_1(l)^|fe_1(3)  +  44) 

4(1.3)  =  4(3, 1)  «  Ai 04  -  4)[4|fc-r(l,5)  +  K? 
•  Xi\k-imilk-i(Z)/(4)2}  +  4(4)^|fe_r(l) 
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Pk\k— 1  5) 

Pfc|fc-i(3, 5) 
Pk\k-i(5,5) 


S£(2,3)  =  Sl( 3,2)  «  AH/4  -4)[^fe|fe-i(3,5)  +  (4)2 
•^|fc-i(3)^|fc-i(5)/(ri)2]+4(4)X*|fe_1(3) 
rl  =  ((dl.)2  +  K|fc_1(5)]2)1/2 

dlfc  =  (K|.-i(l)]2  +  K|.-i(3)]2)1/2 
4  =  A(<)2/(fk)2  +  ^K,fe-i(5)]2/(dl)2 
+  M^K)2K|fc-i(5)]2/(diri)2 

4  =  [4(j)]S=i 

/^fc(l)  =  44  —  (AlMl)2][^fc|fc-l(l)]2 
+  44P4,fc_1(3)]2 
4(2)  =  44  —  (AiMi)2][^fc|fc-i(3)]2 

+  A3M2  [^l|fc-i(l)]2 

4( 3)  =  [4  -  (Mi)2]K|fc-i(5)]2  +  4(4)2 
4(4)  =  [4(A|  -  Aj)  -  (A>i)2]^,fc-i(l)^|fc-1(3) 
4(5)  =  4(4  —  4)  —  A^  (Mi)2]-^fc|fc_1  (5) 

We  first  extend  the  above  recursive  LMMSE  filtering  with 
measurments  from  a  single  radar  to  the  multi-radar  centralized 
fusion  case.  Then  we  are  mainly  interested  to  see  whether 
there  is  still  room  to  improve  performance  under  the  recursive 
LMMSE  filteing  framework. 

III.  Recursive  LMMSE  Centralized  Fusion  with 
Radar  Measurements 

A  basic  idea  for  centralized  fusion  is  to  stack  the  mea¬ 
surements  from  all  sensors  first  and  then  use  the  stacked 
measurements  as  the  measurements  for  estimation. 

Let 


zk  =  [(ziy  {zjfy  ]',  zk  =  {zt}k=1  u) 

Then  the  following  theorem  for  multi-radar  centrazlied  fusion 
holds. 

Theorem  1:  Given  Xk_ , \k_  1  =  E*[Xk-i\Zk~1]  and 

Pk-i\k-i  =  MSE(Xfc_1|^_1|Zfc_1),  the  recursive  LMMSE 
centralized  fusion  for  Xk  can  be  obtained  as 


-Pfc|fc-t([l)  3,  5],  [1,  3,  5]) 

Pfc|fc-l(l,l)  Pk\k-lO-i  3) 

=  ffc|/c-i(3, 1)  Pfc|fc_i(3,  3) 

4c|/c-i(5, 1)  Pfc|fc_i(5,3) 

Proof: 

The  LMMSE  estimator  E*[Xk\Zk]  always  has  the  follow¬ 
ing  quasi-recursive  form  [15] 


Xk\k  =  E*[Xk\Zk }  =  E*[Xk\Zk~\Zk] 

=  Xk\k_i  +  Ck\k_iSk  1(Zk  —  Zk\k_i) 
pk |fc  =  MSE(Xfc|fc| Zk)  =  Pk |fc_!  -  Ck\k-1St1Ck\k_1 

From  the  stacked  measurement  (1),  we  have 


Zk\k-i  =E*  [Zk\Zk~x] 

=  [  E*[Zl\Zk~x}'  ■■■  E*[Zjf  \Zk-1]'  }' 

=  [(4|fc-i)'  {Z&-JY 

Ck\k-1  =  cov(Xk\k-i,  Zk\k~i) 

=  [  COV^fclfc-!,^!^)  cov(Xfc| k-i,^^)] 

_  r  piM  ] 

—  [  *  *  ‘  J 


Sk  =  COv(-4|fc-l) 


qM,  1  qM,  2 
D k  D k 


Sl’M  1 

sr 


sff 


From  Lemma  2  of  [13],  it  follows  that 

4’4M)  =c°v(4|fe-1>4|fe_1) 

=  4441  -  ^[4|fc-i4|fc-i] 


where 


[ A-  |  k ,  -4  |  ] 

filtering {Xk^k_k ,  Pk_k |&_i ,  1 ,  4c|/c—  1 5  *4 ) 

where 

Zk\k—  1  Zvfc  4c|/c— 1 


II 

1 

-se 

<ts^ 

(4|/c-l 

(44 ..1)' : 

II 

1 

o' 

C'kV-i 

riM  i 

'  ’  *  °fc|fc-l  J 

r  4 

42  •••  4M1 

sk  = 

42’1 

5,2  •  •  •  4,M 

-  sf’1 

<gM,2  _  _  _  gM 

S*-%=niPfc|fc_i([l,3,5],[l,3,5])ni)  = 


-l(l)4clfc-l(l)] 

l*fc|fc-l] 

Ifc  +  el)  cos(bfc  +  b\)) 
4)  cos(bfc  +  4))] 

.  -  yfc  sin  bl  cos  ej. 

- rk  sin  bk  cosek 

f k 

.  Yk^-k  •  iA  •  ~i 

H — - —  sin  6^.  sin  ej. 
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•  (xfc  cos  bJk  cos  e°k  -  yk  sin  b3k  cos  e3k 
H — -r{  cos  bl  cos  el  —  —  r{  sin  bl  cos  el 

XfcZfc  7j  .  YfcZfc  .  7j  . 

- - —  cos  61  sin  ei  H - - —  sm  01  sin  ei 

dfc  k  fc  dfc 

-  cos  sin e{  +  sin  b{  sin e{)] 

dfcrfc  dfcrfc 

dfc  =  (xfc  +  Yfc)1^2 

Thus 


^(M)  =  A! /4 A{ a4 (.E [xfcXfc]  -  ^[xfeifc-iXfcifc-!]) 
=  cov(xfe|A,_1)  =  A>lAj/xjPfc|fc_i(l,  1) 

Similarly, 

^'(l,2)  =  A>iAV1Pfc|fc_1(l,3) 
^(l,3)  =  A>>j^fc|fc-i(l,5) 

^(2,l)  =  A>iAV1Pfc|fe_1(3,l) 
^(2,2)  =  A>iAitiPfc|fe_1(3,3) 
^'(2,3)  =  A>i^i^fc|fc-i(3,5) 

^'(3,l)  =  MlAiM-Pfc|fc-i(M) 

^'(3,2)  =  MlAi^1Pfe|fc_1(5,3) 

SkJ(3,3)  =  MiMiPk  |fc— 1(5, 5) 

In  summary. 

^’j  =  ^fc|fc-r([l,3,5],[l,3,5])% 


□ 

Remark:  Compared  with  the  single  radar  case  in  Sec.  II, 
only  the  off-digonal  blocks  of  Sk  are  new. 

Remark:  According  to  [13],  under  the  recursive  LMMSE 
filtering  framework,  Z^k_1  and  Ck |fc_1  can  be  obtained 
exactly,  but  Sk  needs  approximation.  However,  for  nrulti-radar 
centralized  fuison,  Sk°  can  also  be  obtained  exactly.  This 
makes  the  recursive  LMMSE  nrulti-radar  centralized  fusion 
much  easier  unexpectedly. 

Remark:  In  practice,  multiple  radars  may  work  asyn¬ 
chronously  due  to  different  sampling  rates,  different  initial 
times,  etc.  For  this  case,  we  can  align  measurements  made 
at  different  time  instants  to  a  common  fusion  time  [16]. 
However,  due  to  common  process  noise,  measurement  noise 
of  each  radar  will  be  correlated  with  the  process  noise, 
and  measurement  noises  across  radars  will  be  correlated  too. 
Further  work  will  be  done  to  extend  nrulti-radar  recursive 
LMMSE  centralized  fusion  above  to  the  asynchronous  case. 

One  may  think  that  Theorem  1  presents  the  optimal  multi¬ 
radar  centralized  LMMSE  fusion.  However,  this  is  not  the 
case.  As  shown  below,  although  recombination  of  linear  mea¬ 
surements  do  not  improve  performance  of  centralized  fusion, 
it  does  for  nrulti-radar  centralized  LMMSE  fusion. 


IV.  Recursive  LMMSE  Centralized  Fusion  with 
Recombined  Radar  Measurements 
Let  us  first  examine  the  use  of  recombination  for  centralized 
fusion  with  linear  measurements. 


A.  Linear  Measurements 

Suppose  that  we  have  M  sensors  of  non-radar  type.  Each 
of  them  observes  the  target  position  in  Cartesian  coordinates 
directly  as 

4  =  xfc  +  4 

Vk  =  Vk  +  y  l 

4  =  zk  +  4 

where  i  =  1,2,- ••  , M,  and  (xk),  (yk)  and  (zk),  which 
are  independent  of  each  other  and  of  Xo  and  (Wk),  are  all 
zero-mean  white  Gaussian  measurement  noise  sequences  with 
standard  deviations  cr®,  a®  and  cr®,  respectively.  It  is  also 
assumed  that  these  noises  are  independent  across  sensors. 

The  measurement  from  the  i-th  sensor  can  be  rewritten  in 
a  compact  form  as 

Z®  =  DkXk  +  Vl 

where 


Zl  =  [  4  vi  4  ]' 


Dk 


1  0  0  0  0 
0  0  10  0 
0  0  0  0  1 


0 

0 

0 


Vi  =  [  4  vi  4  Y 

E[Vi]  =  Osxr,  R{  =  cov(^)  =  diag{(a®  )2,  (cr®  )2,  (cr®)2} 

Define 


zk  =  [(ziy  ...  (zf)']' 
zk  =  {zt}\ u 

Hk  =  [D'k  D'k  ]' 

Ilk  =  diag{/4,  ■  •  ■  ,  Rff} 

Given  X°_1|fc_x  =  E*[Xk^\Zk-3]  and  P^k_x  = 

MSE(A^_1|fc  l|Zfc_1),  it  is  well  known  that  centralized  fu¬ 
sion  of  Xk  can  be  obtained  as 


[X°k{  k,Pgik] 

=  filtering(X((_1|fc_1,  P^_1|fc_1,  Z^fc_1,  5fc) 

where 


Z,°|fc-r  =Zk~  HkX^k_x 
Ck  |fc-r  =  iVi#£ 

Sk  =  HkP^Hl  +  Rk 

For  each  of  the  x,  y  and  2  dimensions,  order  the  standard 
deviations  of  all  M  sensors  at  the  fusion  center.  Then  we  have 


-(1) 

X 

<42) 

<  • 

■  ■  <  4M) 

-(1) 

<42) 

<  • 

■  •  <  4M) 

V 

—  y 

-(i) 

2: 

<42) 

<  • 

■  ■  <  4M) 

1388 


where  a i1*  is  the  best  of  {er*  }f£k,  ai2-*  the  second  best,  <riM^ 
the  M-th  best,  i.e.,  the  worst.  Likewise  for  y  and  z  dimensions. 

Now  construct  M  virtual  sensors  at  the  fusion  center,  each 
observing  the  target  position  in  all  three  dimensions.  Denote 
Zk'>  =  [  ]7  as  the  measurements  of  the  z-th 

(i) 

virtual  sensor  along  all  three  dimensions.  Suppose  that  crx  is 
the  original  cry ,  cry  the  original  u™* ,  and  <j\  ’  the  original 
<t™%  li,  nii,  rii  =  1,  2,  ■  ■  ■  ,  M.  Then  measurements  of  the  z-th 
virtual  sensor  can  be  constructed  as 


Si) 


=  x 


k  > 


(*) 

Vk 


Vk 


Si) 


=  z 


Hi 

k 


Correspondingly, 

4°  =  °kXk  +  n(<) 


where 

v^  =  \xf  $  -zfy=.  14*  t/r  4nir 

^(i)]=03xr 

=  cov(14W)  =  diag{(4*)2,  (a™*)2,  KO2} 


Remark:  The  above  procedure  is  called  recombination  in 
this  paper.  After  recombination,  virtual  sensor  1  is  the  best  of 
all  M  virtual  sensors  in  terms  of  measurement  accuracy  in  all 
three  dimensions;  virtual  sensor  2  is  the  second  best,  and  so 
on.  Before  recombination,  it  is  hard  to  rank  sensors  if  all  three 
dimensions  are  considered. 

Remark:  To  distinguish  from  the  original  sensors,  we  use 
“virtual  sensors”  to  emphasize  that  they  are  the  result  of 
recombination  and  exist  only  conceptually  at  the  fusion  center. 

Define  Zk,  Zk,  fir  as  the  counterparts  of  Zk,  Zk ,  Rk 
for  the  stacked  measurements  from  the  ranked  virtual  sen¬ 
sors.  Given  =  E*[Xk_1  |Zfc_1]  and  J>fc_1|A._1  = 

MSE(X^_1|fc_1|Zfc_1),  centralized  fusion  of  Xk  with  the 
recombined  measurements  can  be  obtained  as 


[Xk\kiPk\k\ 

=  filtering^,,.,,  Z^,  Ck\k-U  Sk) 

where 


Zrk\k-i  =  Zk~  HkX{]k_ r 

Ck\k-l  =  Pk\k-\H'k 

Sk  =  HkP^Hl  +  Rk 


Then  a  natual  question  arises.  If  Xk_1^k_1  =  Xjl_1\k_1  and 


do  _  pr 

rk-l\k-l  ~  rk-l\k-l' 


^  Xfo  =  X^k 


and  P°k \k  =  Prk]k? 


That  is,  if  centralized  fusion  with  the  original  measurements 
(denoted  by  superscript  “o”)  and  centralized  fusion  with  the 
recombined  measurements  (denoted  by  superscript  “r”)  have 
the  same  estimation  results  at  time  k  —  1,  will  they  be  so  at 
time  /,:?  The  answer  is  yes  for  the  linear  measurement  case. 
This  can  be  easily  shown  as  follows. 

Let  p  =  3(z  —  1),  k  =  3 (li  —  1),  fhi  =  3(rrii  —  1),  Hi  = 
3(rij  —  1).  Construct  a  3 M  x  3 M  square  matrix  Tk  such  that 
all  its  entries  are  zeros  except  that  the  (p  +  1,  h  +  l)th,  (p  + 


2,  rrii  +  2)th,  and  (p  +  3 ,  n*  +  3)th  entries  ai'e  all  1.  Then  it 
can  be  easily  seen  that 

Zk  =  TkZk 

Tk  is  nothing  but  a  3 M  x  3 M  elementary  row  transformation 
matrix,  so  it  is  invertible.  Thus  by  the  property  of  LMMSE 
estimation,  centralized  fusion  with  the  original  measurements 
and  centralized  fusion  with  the  recombined  measurements  will 
be  the  same  if  they  have  the  same  initialization. 

It  is  clear  now  that  recombination  does  not  improve  perfor¬ 
mance  of  centralized  fusion  with  linear  measurements.  This 
also  explains  why  we  do  not  have  the  concept  of  virtual  sensors 
above. 


B.  Radar  Measurements 

Similarly  as  above,  we  can  also  recombine  multi-radar 
measurements  at  the  fusion  center.  For  each  measurement 
component,  i.e.,  range,  bearing  and  elevation,  order  the  stan¬ 
dard  deviations  of  all  radars  at  the  fusion  center. 

Now  construct  M  virtual  radars  at  the  fusion  center,  each 
observing  range,  bearing  and  elevation  of  the  target.  Denote 
Zk^  =  [  x^k  yk^  }'  as  the  converted  measurements  of 

(i) 

the  z-th  virtual  radar  in  all  three  dimensions.  Suppose  that  ov 
is  the  original  a'p ,  a[l  *  the  original  ,  and  erf  the  original 
<t”%  li,mi,rii  =  1,  2,  •  ■  •  ,  M.  Then  converted  measurements 
of  the  z-th  virtual  radar  can  be  constructed  as 


x.  =  r,  cose 


(i)  li 

Vk  =  rfc 


*  cos  b? 


( i )  li  •  n  i 

zl  =ri smek 


Define 

zk  =  [(z^Y  ...  (4M))']' 
zk  =  {zt}k=  i 

Given  X[_1|fc_x  =  E^X^Z^1]  and  = 

MSE(X^_1|jt_1|Zfc_1),  from  Theorem  1,  centralized  fusion 
of  Xk  with  the  recombined  measurements  can  be  obtained  as 


[Xrk^Pk\k\ 

=  filtering(A'^_1n,_1,PJJ'_1|fe_1,  Zk^k_lt  Ck\k-i,  Sk) 


where 


ryr 

Zk\k-i 

Cfc|fc-i 


sk 


zk  —  Zk\k_i 


(^fLi )' 

...  (7(m)  y 

y^klk-l) 

'  ]' 

/ i) 

^k\k-i  ' 

-I 

"  ° k\k-l  1 

Sk} 

sw,w 

SS),(M) 

Sk)’{1) 

k2)  ••• 

S(2)AM) 

1) 

g(M),(2) 

5(m) 
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RMS  Position  Error 


siiUj)  =  nix)Pllk_1([  1,3,  5],  [1,3,5])%) 
n(i)  =  diag{A 


The  fact  that  recombination  does  help  improve  performance 
in  the  case  of  radar  measurements  is  verified  by  the  numerical 
examples  in  the  next  section. 

V.  Examples  and  Discussions 

Next,  we  compare  performance  of  the  recursive  LMMSE 
multi-radar  centralized  fusion  with  the  original  measurments 
(CF-o)  and  with  recombined  measurements  (CF-r)  to  see 
whether  recombination  helps. 

Consider  the  following  three-dimensional  discrete-time  con¬ 
stant  velocity  motion  model  [17]  of  a  target 

Xk  =  Fk-iXk-i  +  Gk-iWk-i 


where 


Xk  =  [  x,t  xfc  yfc  yfc  zfc  zfc  ]',  Xq  ~  J\f(Xo,Po) 
Fk  =  diag{.F,  F,T},  Gk  =  diag{g,g,g} 


T= 


1  T 
0  1 


,g  = 


T2/ 2 
T 


,  T  =  2  s 


Wfc-AAaO  0  0  ]',diagM)2,(^)2,(?D2}) 


Three  radars  co-located  at  the  origin  of  the  Cartesian 
coordinates  were  used  to  observe  the  target  motion.  For  the 
?-th  radar,  the  standard  deviations  of  the  range,  bearing  and 
elevation  measurement  errors  are  axr,  al  and  axe,  respectively, 
i  =  1,2,3. 

The  estimation  accuracy  measures  used  are  root  mean- 
squared  (RMS)  position  and  velocity  errors.  The  filter  credi¬ 
bility  measures  used  are  the  noncredibility  index  (NCI)  [18] 
and  inclination  indicator  (II)  [18],  which  were  shown  to  be 
better  than  the  average  normalized  estimation  error  squared 
(ANEES)  widely  used  in  the  tracking  literature. 

All  results  below  were  averaged  over  500  Monte  Carlo  runs. 
All  filters  were  initialized  with 


-ACq|o  —  X0,  Tb|o  —  Po 


and 


Xq  =  [  —50km  500m/s  200km  Orn/s 
100km  Om/s  ]' 

P0  =  diag{106m2,  202m2/s2, 106m2, 202m2/s2, 
106m2,  202m2/s2} 

<lk=<lk=Qk=  0.01m/s2 


Figure  1.  RMS  Position  Error  (case  1) 


RMS  Velocity  Error 


Figure  2.  RMS  Velocity  Error  (case  1) 

Figs.  1  through  4  show  comparison  results  for  Case  1,  in 
which 

aj.  =  10m,  al  =  lOmrad,  al  =  lOOmrad; 
a2  =  100m,  er2  =  lmrad,  cr2  =  lOmrad; 
al  =  1000m,  al  =  lOOmrad,  a\  =  lmrad; 

From  the  simulation  results,  it  can  be  seen  that  in  terms 
of  estimation  accuracy,  centralized  fusion  with  recombined 
measurements  beats  the  one  with  the  original  measurements 
significantly,  especially  in  position  (by  about  100m).  For  filter 
credibility,  two  fusion  methods  are  almost  the  same  and  they 
are  both  credible. 

Figs.  5  through  8  show  comparison  results  for  Case  2,  in 
which 

al  =  10m,  al  =  20mrad,  al  =  50mrad; 
cr2  =  100m,  al  =  lOmrad,  cr2  =  20mrad; 
af  =  200m,  al  =  50mrad,  a\  =  lOmrad; 


Two  typical  cases  were  considered  to  illustrate  the  use  of 
recombination.  In  the  first  case,  the  difference  in  measurement 
accuracy  of  different  sensors  for  the  same  component  is  huge. 
In  the  second  case,  the  difference  is  not  significant. 


From  the  simulation  results,  it  can  be  seen  that  performance 
difference  is  still  significant,  especially  during  the  steady  state. 
While  both  methods  are  considered  credible,  the  one  with  the 
original  measurements  is  somewhat  more  credible. 
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NCI 


RMS  Velocity  Error 


Figure  3.  NCI  (case  1)  Figure  6.  RMS  Velocity  Error  (case  2) 


Figure  4.  II  (case  1)  Figure  7.  NCI  (case  2) 


RMS  Position  Error 


Figure  5.  RMS  Position  Error  (case  2) 


n 


Figure  8.  II  (case  2) 
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Remark:  LMMSE  estimation  is  the  best  in  the  linear  class, 
but  “in  which  linear  class?”  is  a  crucial  question.  Centralized 
fusion  with  the  original  measurements  is  linear  in  the  origi¬ 
nal  measurements,  while  centralized  fusion  with  recombined 
measurements  is  linear  in  the  recombined  measurements.  Due 
to  the  nonlinear  conversion  from  spherical  coordinates  to 
Cartesian  coordinates,  they  are  two  different  linear  classes. 
So  from  the  above  numerical  examples,  it  can  be  seen  that  the 
linear  class  of  the  recombined  measurements  is  better  than 
the  one  of  the  original  measurements  in  terms  of  estimation 
accuracy  and  filter  credibility.  When  measurements  are  linear, 
recombination  does  not  change  the  linear  class.  This  explains 
why  recombination  helps  improve  performance  of  multi-radar 
recursive  LMMSE  centralized  fusion. 

VI.  Conclusions 

By  following  the  classical  measurements  stacking  method, 
recursive  LMMSE  filtering  for  a  single  radar  in  a  track-while- 
scan  system  has  been  extened  to  the  case  of  centralized  fusion 
with  multiple  radars.  It  is  then  shown  that  centralized  fusion 
done  this  way  does  not  provide  the  best  LMMSE  performance 
achievable.  Interestingly,  centralized  fusion  by  following  the 
measurement  stacking  method  can  be  improved  simply  by 
ranking  scalar  measurements  dimension  by  dimension  and 
recombining  these  measurements.  This  differs  from  the  case 
of  centralized  fusion  with  linear  measurements. 
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